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Abstract of WO 2006042665 (A1) 

The invention relates to a method for determining at 
least one shaft angle (OA) and trailer angle (OB) for 
the trailer of an articulated train, wherein 
characteristic edges and lines of at least the shaft 
and the front side of the trailer are determined from 
the video stream of an imaging sensor, particularly a 
laser scanner.wherein at least the shaft angle (OA) 
and trailer angle (OB) are determined from the 
geometric ratios and/or relative position thereof in 
relation to each other. 
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= (54) Title: METHOD FOR DETERMINING SHAFT AND TRAILER ANGLES 

= (54) Bezeichnung: VERFAHREN ZUR BESTIMMUNG VON DEICHSEL- UND TRAILERWINKEL 




(57) Abstract: The invention relates to a method for determining at 
least one shaft angle (O a ) and trailer angle (O b ) for the trailer of an ar- 
ticulated train, wherein characteristic edges and lines of at least the shaft 
and the front side of the trailer are determined from the video stream of 
an imaging sensor, particularly a laser scanner, wherein at least the shaft 
angle (O a ) and trailer angle (O b ) are determined from the geometric ra- 
tios and/or relative position thereof in relation to each other. 

(57) Zusainnienfassung: Es werden Vcrfahrcn zur Bcstimmung 
mindeslens des Deichselwinkels (O a ) und des Trailerwinkels (O b ) 
eines Anhangers eines Gelenkzuges beschrieben, bei denen aus 
einem Videostrom eines bildgebenden Sensors, insbesondere eines 
Laserscanners, charakteristische Kanten und Linien mindestens 
der Deichsel und der Vorderseite des Anhangers ermittelt werden, 
aus deren geometrischen Verhaltnissen und/oder relativen Lage 
zueinander mindestens der Deichselwinkel (O a ) und der Trailerwinkel 
(Ob) des Anhangers bestimmt werden. 
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Verfahren zur Bestimmung von Deichsel- und Trailerwinkel 



Technisches Gebiet: 

Die Erfindung betrifft ein Verfahren zur Bestimmung 
mindestens des Deichsel- und Trailerwinkels eines Anhangers 
eines Gelenkzuges gemaB der Gattung des Patentanspruchs 1 
sowie gemaB der Gattung des Patentanspruchs 10. 

Stand der Technik: 

Zur Unterstiitzung eines Fahrers eines aus Zugfahrzeug und 
Anhanger bestehenden Lastzuges, insbesondere beim 
Riickwartsfahren, ist es wunschenswert, den Trailerwinkel 
zwischen Zugfahrzeug und Anhanger (auch als „Anhangerwinkel" 
bezeichnet) zu kennen, beispielsweise urn Lenkhinweise zum 
punktgenauen riickwarts Anfahren einer Rampe geben zu konnen 
oder das Riickwartsfahren automatisch ausfiihren zu lassen oder 
urn die Auftenspiegel auf das Ende des Lastzuges auszurichten 
und nachzufiihren . 

Fur solche Anwendungen ist es bekannt, den Trailerwinkel 
zwischen Zugfahrzeug und Anhanger, beispielsweise zwischen 
Sattelschlepper und Sattelauf lieger eines Sattelzuges mittels 
mechanischer Geber zu bestimmen, verbunden mit dem Nachteil 
der Gefahr einer Beschadigung dieser Geber beim Ankuppeln des 
Anhangers oder durch Verschmutzung. 
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Aus der JP 2002-012172 und der JP 2002-068032 ist eine 
Vorrichtung zur Bestimmung des Trailerwinkels bei einem 
Sattelzug mittels einer an dem Sattelschlepper montierten, 
nach hinten auf die Vorderseite des Sattelauf liegers 
gerichteten Kamera bekannt, wobei an der Vorderseite und an 
den anschliefienden Langsseiten des Sattelauf liegers 
Markierungen angeordnet sind, aus deren Sichtbarkeit und 
Position in dem Kamerabild Ruckschliisse auf den Trailerwinkel 
gezogen werden, beispielsweise urn beim Riickwartsf ahren einen 
oder mehrere Riickspiegel auf das Ende des Lastzuges 
auszurichten oder nachzuf iihren . Dies wird dadurch ermoglicht, 
dass bei einem Sattelzug die Sichtbarkeit derartiger 
Markierungen eindeutig einem bestimmten Trailerwinkel 
zugeordnet werden konnen. 

Derartige Vorrichtungen weisen den Nachteil auf, dass die am 
Anhanger angeordneten Markierungen im Alltagseinsatz von 
Nutzfahrzeugen leicht beschadigt, verschmutzt, verdeckt oder 
weggerissen werden konnen, so dass dann eine Erkennung des 
Trailerwinkels nicht mehr moglich ist. 

Bei einem aus Zugfahrzeug und Anhanger, der eine mit einer 
Deichsel verbundene lenkbare Vorderachse aufweist, 
bestehenden Gelenkzug (auch als „Gliederzug" bezeichnet) , 
gestaltet sich die Erkennung des Trailerwinkels im Vergleich 
zu einem Sattelzug ungleich schwieriger, da der Anhanger liber 
die Deichsel, welche ein zusatzliches Gelenk bildet, mit dem 
Zugfahrzeug verbunden ist. So miissen beispielsweise, um beim 
Riickwartsf ahren Lenkhinweise an den Fahrer ausgeben zu konnen 
oder um die Riickspiegel auf das Ende des Lastzuges 
auszurichten und nachzufiihren, neben anderen Groften 
(insbesondere die Abmessungen des Lastzuges betreffende 
GroBen) , mindestens zwei der folgenden Winkel 

- 'Deichselwinkel zwischen Zugfahrzeug und Deichsel, 
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- Trailerwinkel, 

- Drehwinkel zwischen Anhanger und Deichsel 
( „Anhangerlenkwinkel w ) 

bekannt sein, urn die Position des Endes des Lastzuges zu 
kennen oder dessen Bewegungsbahn beim Riickwartsf ahren 
vorherzusagen . 

Dabei ist es grundsatzlich denkbar, den Drehwinkel zwischen 
Anhanger und Deichsel mittels mechanischer Geber zu 
bestimmen, wobei beispielsweise zur Vorhersage der 
Bewegungsbahn des Anhangers zusatzlich der Deichselwinkel 
zwischen Zugfahrzeug und Deichsel bestimmt werden muss. Ein 
zu diesem Zweck im Bereich der Maulkupplung zwischen Deichsel 
und Zugfahrzeug angeordneter mechanischer Geber ist dabei 
sehr hohen mechanischen Belastungen und in hohem Mafie Schmutz 
und Staub ausgesetzt, so dass dessen zuverlassige Funktion 
nicht sichergestellt werden kann. Daruber hinaus weist eine 
derartige Kombination den Nachteil auf, dass die Messwerte 
insbesondere eines am Anhanger angeordneten mechanischen 
Gebers zur Messung des Drehwinkels zum Zugfahrzeug ubertragen 
werden muss en, was einen hohen Aufwand insbesondere im 
Hinblick auf die standardisierten Elektroverbindungen bei 
Lastziigen darstellt. 

Eine Erfassung des Trailerwinkels bei einem Gelenkzug ahnlich 
den in der JP 2002-012172 und der JP 2002-068032 
beschriebenen Vorrichtungen mittels am Anhanger angeordneter 
Markierungen, welche von einer Kamera erkannt werden, 
scheitert daran, dass die Positionen der Markierungen im 
Kamerabild bei einem Gelenkzug nicht wie bei einem Sattelzug 
eindeutig einem bestimmten Trailerwinkel zuordenbar sind, da 
das Gelenk zwischen der Kupplung am Zugfahrzeug und der 
Deichsel einen zusatzlichen Freiheitsgrad fur den 
Trailerwinkel bietet. 
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In der deutschen Patentanmeldung DE 103 22 82 9 Al ist ein 
elektronisches Steuerungssystem fur Fahrzeuge, insbesondere 
Glieder- und Sattelziige beschrieben, das mit Hilfe eines 
Riickf ahr-Algorithmus und einem elektronisch ansteuerbaren 
Antriebsstrang das automatische Riickwartsf ahren ermoglicht. 
Der Antriebsstrang umfasst dabei ein Antriebsaggregat, ein 
Getriebe, eine Lenkungsanlage, eine Bremsanlage sowie eine 
Niveauregulierungsanlage . Das Steuerungssystem berechnet mit 
Hilfe eines Bahnrechners eine Bewegungsbahn, die eine Abfolge 
von Bewegungsvektoren bereitstellt , mit deren Hilfe das 
Fahrzeug von einer Startposition in eine Zielposition 
uberfiihrt werden kann . Die Startposition kann dabei durch 
Istwerte fur die Lage und Position des Fahrzeugs definiert 
werden, die mit Hilfe einer geeignete Lage- und 
Positionsbestimmungseinrichtung, z.B. eine Radar-Anlage, 
bestimmbar sind. Fur die Zielposition werden Sollwerte fur 
die Lage und Position des Fahrzeugs verwendet, die mit Hilfe 
einer Zieleingabeeinrichtung vorgebbar sind. Der Bahnrechner 
ubermittelt dabei die ermittelten Bewegungsvektoren liber eine 
Antriebsstrang-Schnittstelle zur Steuereinrichtung, iiber die 
auch die f ahrzeugfeste Bedieneinrichtung die 
Bewegungsvektoren an die Steuereinrichtung ubermittelt. Das 
Steuerungssystem kann dabei eine Sensorik umfassen, mit deren 
Hilfe der Bahnrechner Fahrzeug-Umgebungsbedingungen wie z.B. 
Abstandswerte beriicksichtigen kann. Bei einem Gelenkzug, bei 
dem der Anhanger iiber eine Deichsel mit dem Zugfahrzeug 
gekoppelt ist, konnen ferner Knickwinkelsensoren vorgesehen 
sein, die den Knickwinkel zwischen Deichsel und Anhanger 
(Anhangerlenkwinkel) und/oder den Knickwinkel zwischen 
Deichsel und Zugfahrzeug (Deichselwinkel) ermitteln. Das 
Steuerungssystem ist insbesondere beim Riickwartsanfahren 
einer Verladerampe niitzlich. 
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Ein fur die Berechnung des Soll-Anhangerlenkwinkels 
geeigneten Verfahrens ist beispielsweise in der deutschen 
Patentanmeldung DE 103 22 828 Al offenbart. 

Technische Aufgabe der Erfindung: 

Der Erfindung liegt die Aufgabe zugrunde, ein Verfahren zu 
entwickeln, welches mit moglichst einfachen Mitteln eine 
zuverlassige Bestimmung des Deichsel- und Trailerwinkels bei 
einem Gelenkzug ermoglicht. 

Diese Aufgabe wird erf indungsgemaft durch die Gegenstande der 
unabhangigen Patentanspruche 1 und 10 gelost. Bevorzugte 
Ausfuhrungsformen sind Gegenstande der abhangigen 
Patentanspruche . 

Offenbarung der Erfindung und deren Vorteile: 
Die Aufgabe wird bei einem Verfahren der eingangs genannten 
Gattung bei einem ersten Gegenstand der vorliegenden 
Erfindung dadurch gelost, dass aus einem mindestens 
zeitweilig, insbesondere beim Ruckwartsf ahren des 
Zugfahrzeugs kontinuierlichen Videostrom eines vorzugsweise 
vom Zugfahrzeug auf den Anhanger gerichteten, bildgebenden 
Sensors, wie beispielsweise einer Videokamera, einem IR- 
Sensor oder einem LIDAR-Sensor, charakteristische Kanten und 
Linien mindestens der Deichsel und der Vorderseite des 
Anhangers ermittelt werden, aus deren geometrischen 
Verhaltnissen und/oder relativen Lage zueinander, 
beispielsweise in einem seinen Koordinatenursprung im 
Brennpunkt des bildgebenden Sensors aufweisenden 
Koordinatensystem, mindestens der Deichselwinkel und der 
Trailerwinkel des Anhangers vorzugsweise kontinuierlich 
bestimmt wird. 



5 



WO 2006/042665 



PCTYEP2005/010920 



Das erf ind.ungsgema.Jie Verfahren weist gegeniiber dem Stand der 
Technik den Vorteil auf, dass es ausschlieiilich durch 
Verwendung eines bildgebenden Sensors, beispielsweise einer 
Videokamera, und ohne zusatzliche Vorrichtungen, wie etwa 
Markierungen oder mechanische Geber, moglich ist, den 
Deichselwinkel und den Trailerwinkel des Anhangers eines 
Gelenkzuges zu bestimmen. Der bildgebende Sensor kann dabei 
wahlweise am Zugfahrzeug oder am Anhanger angeordnet werden, 
wobei vorzugsweise, insbesondere im Hinblick auf die 
Datentibertragung zum Zugfahrzeug, der bildgebende Sensor am 
Zugfahrzeug nach hinten, auf den Anhanger gerichtet 
angeordnet ist. 

Eine vorteilhafte Ausgestaltung des erf indungsgemafien 
Verfahrens sieht vor, dass zunachst anhand der relativen Lage 
und/oder der geometrischen Verhaltnisse der 

charakteristischen Linien und Kanten der Deichsel zueinander 
vorzugsweise innerhalb eines frei wahlbaren 
Koordinatensystems der Deichselwinkel zwischen Zugfahrzeug 
und Deichsel bestimmt wird und anschlieBend aufbauend auf der 
Kenntnis des Deichselwinkels anhand der relativen Lage 
und/oder der geometrischen Verhaltnisse der 
charakteristischen Linien und Kanten mindestens der 
Vorderseite des Anhangers der Trailerwinkel zwischen 
Zugfahrzeug und Anhanger bestimmt wird. Bei Bedarf kann 
anschlieBend anhand des Trailerwinkels und des 
Deichselwinkels durch Subtraktion zusatzlich der Drehwinkel 
zwischen Anhanger und Deichsel bestimmt werden. 

Eine vorteilhafte Ausgestaltung des erf indungsgemaBen 
Verfahrens sieht vor, dass zur Bestimmung der geometrischen 
Verhaltnisse und der relativen Lage der charakteristischen 
Kanten und Linien der Deichsel und mindestens der Vorderseite 
des Anhangers ein Koordinatensystem, dessen Ursprung 
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vorzugsweise im Brennpunkt des bildgebenden Sensors liegt, 
verwendet wird. 

Eine andere vorteilhafte Ausgestaltung des erf indungsgemalien 
Verfahrens sieht vor, dass zur genauen Bestimmung des 
Deichsel- und/oder Trailerwinkels neben den geometrischen 
Verhaltnissen und/oder der relativen Lage der 

charakteristischen Kanten und Linien jeweils der Deichsel und 
der Vorderseite des Anhangers zueinander, zusatzliche, 
anhangerspezif ische Daten, insbesondere der Abstand des 
Drehpunktes der Deichsel von der Vorderseite des Anhangers, 
die Lange der Deichsel, sowie die Breite des Anhangers 
berucksichtigt werden, welche entweder beispielsweise vor, 
beim oder nach dem Ankuppeln cines Anhangers manuell 
eingegeben, einer Datenbank entnommen, oder wahrend des 
Ankuppelns automatisch bestimmt werden. Insbesondere wahrend 
des Ankuppelns ist es moglich, die Deichsellange anhand des 
vom bildgebenden Sensor gelieferten Videostromes automatisch 
zu bestimmen, da zum Zeitpunkt des Ankuppelns das Zugfahrzeug 
mit dem Anhanger und der Deichsel annahernd in einer Linie 
steht. Eine derartige automatische Bestimmung der 
Deichsellange wahrend des Ankuppelns ist beispielsweise 
anhand der Gleichung 



moglich, wobei D die Deichsellange, f die Brennweite des 
bildgebenden Sensors, d der Abstand zwischen dem Drehpunkt 
der Vorderachse des Anhangers und der Vorderseite des 
Anhangers und L y und R y die Abstande der linken und der 
rechten Seite der Vorderseite des Anhangers guer zur 
Blickrichtung des bildgebenden Sensors sind. 

Eine zusatzliche, vorteilhafte Ausgestaltung des 

erf indungsgemaBen Verfahrens sieht vor, dass zur Bestimmung 



D = 



f-W 



+ d 
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des Deichselwinkels zunachst eine 2D-Ableitung des 
Videostromes des bildgebenden Sensors und anschlieBend eine 
eine Umwandlung des Farb- oder Graustufenbildes des 
bildgebenden Sensors in eine reine Zweif arbdarstellung 
bewirkende Binarisierung mit einem voreinstellbaren, 
vorzugsweise beleuchtungsabhangigen Schwellenwert 
durchgefiAhrt wird, so dass die charakteristischen Kanten und 
Linien der Deichsel, welche sich alle in einem Punkt unten im 
vom bildgebenden Sensor auf genommenen Bild treffen, eindeutig 
hervortreten, wonach aus dem binarisierten Videostrom 
anschlieUend die charakteristischen Kanten und Linien mittels 
einer Hugh-Transformation gefiltert werden und ein Modell der 
Deichsel auf die gefilterten Kanten und Linien platziert 
wird, urn anschlieBend mit einem den Blickwinkel des 
bildgebenden Sensors und damit die perspektivischen 
geometrischen Verhaltnisse der charakteristischen Kanten und 
Linien berucksichtigenden Iterations-Algorithmus, 
beispielsweise einem Iterative Closest Point Algorithmus IPC, 
vorzugsweise von 0° an beginnend die Lage des Modells auf den 
gefilterten Kanten und Linien so weit zu optimieren, bis der 
tatsachliche Deichselwinkel gefunden ist. 

Eine besonders vorteilhafte Ausgestaltung des 
erf indungsgemafien Verfahrens sieht vor, dass zur Bestimmung 
des Trailerwinkels zusatzlich ein Modell der Vorderseite des 
Anhangers auf die nach der Hugh-Transformation gefilterten 
Kanten und Linien gelegt wird, welches ebenfalls durch einen 
den Blickwinkel des bildgebenden Sensors und damit die 
perspektivischen geometrischen Verhaltnisse der 
charakteristischen Kanten und Linien berucksichtigenden 
Iterations-Algorithmus, beispielsweise einem Iterative 
Closest Point Algorithmus IPC, vorzugsweise von 0° an 
beginnend in seiner Lage auf den gefilterten Kanten und 
Linien so weit optimiert wird, bis die Lage des Modells mit 
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der Lage der charakteristischen Kanten und Linien der 
Vorderseite des Anhangers im Videostrom ubereinstimmen, wobe 
anschlieJJend anhand des Deichselwinkels und der Lage der 
charakteristischen Kanten und Linien der Vorderseite des 
Anhangers eine geometrische Berechnung des Trailerwinkels 
erf olgt . 

Eine andere, besonders vorteilhafte Ausgestaltung des 
erf indungsgemalien Verfahrens sieht vor, dass zur Bestimmung 
des Trailerwinkels zwei vom Brennpunkt des bildgebenden 
Sensors ausgehende und an der linken und rechten Kante der 
Vorderseite des Anhangers jeweils unter einem Streifwinkel 
vorbeistreifenden Streiflinien verwendet werden, welche in 
ihre Komponenten in einem Koordinatensystem, dessen Ursprung 
vorzugsweise im Brennpunkt des vorzugsweise vom Zugfahrzeug 
gerade nach hinten gerichteten bildgebenden Sensors liegt, 
zerlegt werden, so dass eine Bestimmung des Trailerwinkels 
durch Losung der Gleichungen 

( W \ 

fr\ D-cos6 A + — smO B -d-cos9 B 



erfolgt, mit L als der Lange der Streiflinie links, R als de 
Lange der Streiflinie rechts, L x und R x jeweils als den 
Komponenten in der Blickrichtung des bildgebenden Sensors 
entsprechender x-Richtung und L y und R y jeweils als den 
Komponenten in quer zur Blickrichtung des bildgebenden 



L, 




und 
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Sensors entsprechender y-Richtung der jeweiligen Streiflinie 
im Koordinatensystem mit Ursprung im Brennpunkt des 
bildgebenden Sensors, 0l als dem im Bild gemessenen 
Streifwinkel zwischen der x-Koordinatenachse und der linken 
Streiflinie L, 6 R als dem im Bild gemessenen Streifwinkel 
zwischen der x-Koordinatenachse und der rechten Streiflinie 
(R) und d, D und W als dem Abstand des Drehpunktes der 
Deichsel von der Vorderseite des Anhangers, die Lange der 
Deichsel, sowie die Breite des Anhangers. 

Eine vorteilhafte Ausgestaltung des erf indungsgemaBen 
Verfahrens sieht vor, dass zur Verbesserung der Genauigkeit 
zusatzlich ein Modell der Ladeflache auf im binarisierten 
Videostrom erkennbare charakteristische Kanten und Linien der 
Ladeflache gelegt wird. 

Eine andere vorteilhafte Ausgestaltung des erf indungsgemaflen 
Verfahrens sieht vor, dass zusatzlich ein Kallmanns-Filter 
verwendet wird. 

Ein zweiter Gegenstand der vorliegenden Erfindung ist ein 
Verfahren zur Bestimmung mindestens des Deichselwinkels (0 a ) 
und des Anhangerwinkels (G B ) eines Anhangers eines 
Gliederzugs, wobei aus einem Videostrom eines Laserscanners 
charakteristische Kanten und Linien mindestens der Deichsel 
und der Vorderseite des Anhangers ermittelt werden, aus deren 
geometrischen Verhaltnissen und/oder relativer Lage 
zueinander mindestens der Deichselwinkel (0 A ) und der 
Trailerwinkel (6 B ) des Anhangers bestimmt werden. Das 
Verfahren weist erf indungsgemaJ3 die folgenden Schritte auf: 
a) Ermittlung der Entfernungen zu Messpunkten (mi) an der 

dem Zugfahrzeug zugewandten Vorderseite des Anhangers mit 
Hilfe des Laserscanners, wobei die Messpunkte (mi) in der 
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Ebene eines zweidimensionalen kartesischen 
Koordinatensystems liegen, dessen Ursprung (0) der 
Laserscanner ist, vorzugsweise der Brennpunkt des 
Laserscanners und insbesondere der ob j ektseitige 
Brennpunkt des Laserscanners, und dessen x-Achse parallel 
zur Langsachse des Zugfahrzeugs verlauft; 

b) Bestimmung einer Ausgleichsgeraden (G) durch alle zur dem 
Zugfahrzeug zugewandten Vorderseite des Anhangers 
gehorenden Messpunkte (mi) ; 

c) Bestimmung einer die Mitte der Ausgleichgeraden (G) 
schneidenden Senkrechten (S) , wobei die Senkrechte (S) 
parallel zur Langsachse des Anhangers verlauft; 

d) Bestimmung des Drehpunkts (Pi) der Deichsel mit Hilfe der 
Lange der Deichsel (D) und der Lage der Senkrechten (S) ; 

e) Bestimmung des Schnittpunkts (P2) der Senkrechten (S) mit 
der x-Achse; 

f) Bestimmung der Winkel (0 A , 0 B , 6c) in dem aus Ursprung 
(0), Drehpunkt (Pi) und Schnittpunkt (P 2 ) gebildeten 
Dreieck, wobei es sich 

• bei dem Winkel zwischen Langsachse der Deichsel und 
Langsachse des Zugfahrzeugs um den Deichselwinkel 

(6 A ) handelt; 

• bei dem Winkel zwischen den Langsachsen von Anhanger 
und Zugfahrzeug um den Trailerwinkel (6 B ) handelt; 

• und bei dem Winkel zwischen Langsachse des Anhangers 
und Langsachse der Deichsel um den Anhangerlenkwinkel 

(G c ) handelt. 

Dabei konnen bestimmte, fiir das erf indungsgemaiie Verfahren 
erforderliche Daten, wie z.B. die Deichsellange (D) , bereits 
aus vorhergegangenen Messungen bekannt und beispielsweise in 
einer Datenspeichereinrichtung (Datenbank, Computer oder 
dergleichen) abrufbar hinterlegt sein, oder sie werden bei 
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Bedarf bestimmt, z.B. mit Hilfe des Laserscanners . Bei dem 
Laserscanner kann es sich urn einen LIDAR-Sensor handeln. 

Um aus den mit Hilfe des Laserscanners ermittelten Daten, 
insbesondere Entf ernungs- und Abstandsdaten, die gewunschten 
Inf ormationen zu gewinnen und v. a. die Schritte des 
erf indungsgemaften Verfahrens durchzufiihren, setzt man 
zweckmaMgerweise eine dafiir geeignete Berechnungseinrichtung 
ein, vorzugsweise einen Computer mit einem oder mehreren fur 
die Durchfiihrung der erforderlichen Rechenoperationen 
geeigneten Programmen. Dafiir geeignete 

Berechnungseinrichtungen, Computer und Programme sind dem 
Fachmann prinzipiell bekannt und werden daher der Kiirze 
halber nicht naher erlautert. 

Das erf indungsgemaBe Verfahren ermoglicht es, fur 
Lenkhinweise bei der Riickwartsf ahrt von Fahrzeugen, 
insbesondere von Gliederziigen, erf orderliche Daten wie den 
Deichselwinkel (6 A ) und den Trailerwinkel (0 B ) auf einfache 
Weise und mit hoher Zuverlassigkeit zu bestimmen. 

Weitere Merkmale und Vorteile der Erfindung ergeben sich aus 
den Unteranspriichen, der Beschreibung, aus der Zeichnung und 
aus der zugehorigen Figurenbeschreibung anhand der Zeichnung. 

Bei einer Weiterentwicklung des erf indungsgemafien Verfahrens 

bestimmt man bei einer Geradeausfahrt 

charakteristischen Kanten und Linien des Anhangers 

sowie Entfernungen zu den Messpunkten (mi) an der Vorderseite 

des Anhangers 

und bestimmt daraus die Breite (W) des Anhangers. 
Mit Hilfe der Breite (W) konnen die zur dem Zugfahrzeug 
zugewandten Vorderseite des Anhangers gehorenden Messpunkte 
(mi) mit groflerer Zuverlassigkeit erkannt werden. Ferner kann 
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mit Hilfe der genauen Kenntnis iiber die Breite (W) die Mitte 
der Vorderseite des Anhangers fur die Bestimmung der 
Senkrechten (S) zur Ausgleichsgeraden (G) mit groBerer 
Zuverlassigkeit bestimmt werden. 

Bei einer weiteren Weiterentwicklung des erf indungsgemaBen 
Verfahrens bestimmt man bei einer Geradeausf ahrt 
charakteristischen Kanten und Linien des Anhangers 
sowie Entfernungen zu den Messpunkten (mi) an der Vorderseite 
des Anhangers 

und bestimmt daraus den Abstand (A) zwischen Zugfahrzeug und 
Anh anger . 

Die Kenntnis des Abstands (A) tragt ebenfalls zur besseren 
Erkennung der dem Zugfahrzeug zugewandten Vorderseite des 
Anhangers gehorenden Messpunkte (mi) bei. 

Bei noch einer weiteren Weiterentwicklung des 

erf indungsgemaBen Verfahrens bestimmt man bei einer 

Geradeausf ahrt 

charakteristischen Kanten und Linien der Deichsel 

sowie Entfernungen zu den Messpunkten (m ± ) an der Vorderseite 

des Anhangers 

und bestimmt daraus die Deichsellange (D) . 

Konkrete Ausfuhrungsbeispiele der Erfindung sind in den 
Figuren vereinfacht dargestellt und werden in der 
nachfolgenden Figurenbeschreibung naher erlautert, wobei sich 
gleiche Bezugszeichen auf gleiche, funktionell gleiche oder 
ahnliche Bauteile beziehen. Dabei zeigen, jeweils 
schematisch: 

Fig. 1 eine schematische Darstellung der Winkel und GroBen 
zwischen Zugfahrzeug und Anhanger eines 
Gelenkzuges, 
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Fig. 2 eine schematische Darstellung des vom bildgebenden 

Sensor erfassten Bildes beim Ankuppeln des 

Zugfahrzeugs an den Anhanger, 
Fig. 3 eine Darstellung eines vom bildgebenden Sensor 

aufgenommenen und in eine Zweif arbdarstellung 

umgewandelten Bildes, sowie 
Fig. 4 ein Flussdiagramm des erf indungsgemaBen Verfahrens, 
Fig. 5 eine weitere schematische Darstellung der Winkel 

und GroUen zwischen Zugfahrzeug und Anhanger eines 

Gelenkzuges, 

wobei nur die fur das Verstandnis der Erfindung erf orderliche 
Merkmale bezeichnet sind. 



Wege zur Ausfuhrung der Erfindung: 
Zur Bestimmung des Deichselwinkels (0 A ) und des 
Trailerwinkels (9 B ) eines aus Zugfahrzeug und Anhanger (2) 
mit lenkbarer Vorderachse und Deichsel (1) bestehenden 
Gelenkzuges ist auf dem Zugfahrzeug, vorzugsweise mittig 
oberhalb dessen Maulkupplung, ein nach hinten gerichteter 
bildgebender Sensor, beispielsweise eine Videokamera oder ein 
Laserscanner angeordnet. Die mit x und y bezeichneten Achsen 
eines seinen Ursprung im Brennpunkt des bildgebenden Sensors 
aufweisenden Koordinatensystems weisen dabei im Falle der x- 
Achse vom Zugfahrzeug aus nach hinten und im Falle der y- 
Achse querab zum Zugfahrzeug im rechten Winkel zur x-Achse. 
Die Koordinatenachsen sind dabei durch die Blickrichtung des 
bildgebenden Sensors vorgegeben, so dass ebenso denkbar ist, 
den nach hinten gerichteten, bildgebenden Sensor seitlich am 
Zugfahrzeug oder sogar beweglich, beispielsweise urn dessen 
Hochachse schwenk- und/oder um dessen Querachse neigbar 
anzuordnen. Daruber hinaus muss der bildgebende Sensor nicht 
zwingend genau nach hinten ausgerichtet sein, da das 
Verfahren geeignet ist, derartige Ausrichtungsf ehler zu 
kompensieren . 
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Aus den in Form eines Videostromes kontinuierlich vom 
bildgebenden Sensor erfassten Bildern des Anhangers (2) 

konnen die Winkel (9 L ) zwischen der vom Koordinatenursprung 
ausgehend links an der Vorderseite des Anhangers (2) 
vorbeifuhrende linken Streiflinie (L) und (G R ) zwischen der 
vom Koordinatenursprung ausgehend rechts an der Vorderseite 
des Anhangers (2) vorbeifuhrende rechten Streiflinie (R) 
bestimmt werden. Vorzugsweise wird hierzu jeweils ein Modell 
auf die charakteristischen Kanten und Linien (4) der Deichsel 
(1) und die charakteristischen Kanten und Linien (5) 
mindestens der Vorderseite des Anhangers (2) gelegt. 

Um eine moglichst genaue Erkennung der charakteristischen 
Kanten und Linien (4) und (5) der Deichsel (1) und des 
Anhangers (2) durchzufuhren, ist vorgesehen, den Videostrom 
durch so genanntes Binarisieren in eine reine 
Zweif arbdarstellung umzuwandeln . Dies erfolgt durch eine 
insbesondere aus der elektronischen Bildbearbeitung bekannte 
Umwandlung der in Farbe oder in Graustufen vorliegenden 
Bilder, beispielsweise in eine SchwarzweiB-Darstellung 
mittels eines insbesondere beleuchtungsabhangig 
voreinstellbaren oder automatisch an die 

Beleuchtungssituation anpassbaren Schwellenwerts . Dabei wird 
jedes Pixel des Videostromes mit einem Wert groJier als der 
Schwellenwert auf 1 und jedes Pixel mit einem Wert kleiner 
als der Schwellenwert auf 0 gesetzt. 

In der Zweif arbdarstellung treten bei geeignet gewahltem 
Schwellenwert die charakteristischen Kanten und Linien (4) 
und (5) der Deichsel (1) und des Anhangers (2) deutlich 
hervor. Auf die charakteristischen Kanten und Linien (4) der 
Deichsel (1) wird ein Modell der Deichsel (1) gelegt. Durch 
iteratives Ausrichten des Modells der Deichsel beginnend bei 
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0 A = 0° auf den charakteristischen Kanten und Linien (4) der 
Deichsel (1) im zweifarbigen Bild wird der Deichselwinkel 0 A 
bestimmt. Es ist denkbar, die charakteristischen Kanten und 
Linien (4) der Deichsel (1) zur besseren Zuordenbarkeit 
mittels einer Hugh-Transformation zu filtern. 



Ist der Deichselwinkel (0 A ) durch Iteration bestimmt, kann 
eine Bestimmung des Trailerwinkels (9 B ) durch Losung der 



Gleichungen 



K R yJ 



W 



D- cos9 A + — ■ sin<9g - d ■ cos6 B 
W 

D-sin6 A + — cos 6 B + d- sm9 3 



W 

D-cos6 A sind B -d-cos9 B 

W 

D-sin0 A cos9 B + d-smO B 



und 



6, - arctan— 



6 P - arctan^- 

R x 

erfolgen. Dazu wird ein Modell der Vorderseite des Anhangers 
(2) auf die charakteristischen Kanten und Linien (5) des 
Anhangers (2) gelegt, wodurch sich die Langen der 
Streiflinien (L) und (R) sowie deren Komponenten in x- und y- 
Richtung sowie die Winkel (0 L ) und (0 R ) besser bestimmen 
lassen . 



Hierzu miissen vorab einige GroBen des Anhangers (2) bekannt 
sein. Die wesentliche GroBe der Deichsellange (D) kann dabei 
wahrend des Ankuppelns des Anhangers (2) an das Zugfahrzeug 
automatisch bestimmt werden. Wahrend des Ankuppelns des 
Anhangers (2) steht das Zugfahrzeug ausreichend genau in 
einer Linie mit dem Anhanger (2) und dessen Deichsel (1) . Das 
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zu diesem Zeitpunkt vom bildgebenden Sensor erfasste Bild mit 
der Deichsel (1) , der Vorderseite und den Reifen (3) des 
Anhangers (2) ist in Fig. 2 dargestellt. Mit Kenntnis der 
Breite (W) des Anhangers (2) und des Abstandes (d) des 
Drehpunktes der Deichsel (1) von der Vorderseite des 
Anhangers (2) ist anhand der Gleichung 



die Deichsellange (D) bestimmbar. Die GroBen W, d und f sind 
beispielsweise einer Datenbank entnehmbar oder manuell 
eingebbar. Dabei ist f die Brennweite des bildgebenden 
Sensors und L y und R y die im Bild unter Riickgriff auf die 
Breite (W) des Anhangers (2) bestimmbaren Abstande der linken 
und der rechten Seite der Vorderseite des Anhangers (2) 
orthogonal zur x-Achse. Ist die Breite (W) des Anhangers (2) 
nicht bekannt, wird von einem Standardwert von 2,5 m 
ausgegangen. Markttibliche Anhanger (2) weichen von dieser 
Breite urn etwa ± 0,1 m ab, woraus sich insbesondere bei der 
spateren Berechnung des Deichselwinkels (9 A ) und des 
Trailerwinkels (0 B ) ein maximaler Fehler von lediglich + 2° 
ergibt . 

Mit der zusatzlichen Kenntnis der Deichsellange (D) kann 
nunmehr kontinuierlich aus dem Videostrom die Lange der 
linken (L) und der rechten (R) Streiflinie beziehungsweise 
deren Komponenten in x- und y-Richtung berechnet und so der 
Deichselwinkel (0 A ) und der Trailerwinkel (9 B ) kontinuierlich 
ermittelt werden. 

Vorzugsweise wird das Verfahren in Verbindung mit einer 
elektronischen Datenverarbeitungseinrichtung durchgef iihrt , 
welche die Schritte des Verfahrens mit Hilfe eines 
Sof twareprogramms automatisch ausf iihrt. Dieses 



D = 



f-W 



+ d 
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Softwareprogramm verfiigt dabei vorzugsweise fur verschiedene 
Anhanger (2) tiber verschiedene voreinstellbare Parameter und 
ist dabei vorzugsweise in der Lage, zum Zweck einer 
automatischen Anpassung und Umstellung der Parameter diese 
Anhanger (2) sowie gegebenenf alls die Art des Aufbaus des 
Anhangers (2), beispielsweise ob es sich urn einen 
Container anhanger, eine Pritsche oder dergleichen handelt, 
automatisch zu erkennen. 

Kern der Erfindung ist es, ohne als mechanische Geber 
ausgeftihrte Winkelsensoren und ohne spezielle Markierungen, 
ausschliefilich unter Verwendung eines bildgebenden Sensors 
den Deichselwinkel (8 A ) und den Trailerwinkel (6 B ) des 
Anhangers (2) eines Gelenkzuges bestimmen zu konnen. 

Dabei ist es selbstverstandlich ebenso denkbar, das Verfahren 
zur Bestimmung des Trailerwinkels (0 B ) eines Sattelzuges 
anzuwenden, um gegenuber dem Stand der Technik auf besondere 
Markierungen am Sattelauflieger verzichten zu konnen. 

Fig. 5 zeigt in einer stark vereinf achten Prinzipdarstellung 
einen Gelenkzug (6) mit einem Zugfahrzeug (7) und einem 
Anhanger (2) . Der Anhanger (2) ist iiber eine Deichsel (1) an 
das Zugfahrzeug (7) gekoppelt. Das Zugfahrzeug (7) weist eine 
Langsachse (9) auf. Ebenso weist der Anhanger (2) eine 
Langsachse (10) auf. Ferner weist das Zugfahrzeug (7) einen 
Laserscanner (11) auf, der an der riickwartigen Wand des 
Zugfahrzeugs (7) in deren horizontalen Mitte angeordnet ist. 
Der objektseitige (d.h. dem Anhanger zugewandte) Brennpunkt 
des Laserscanners (11) bildet den Koordinatenursprung (0) 
eines zweidimensionalen kartesischen Koordinatensystems, bei 
dem die x-Achse parallel zur Langsachse (9) des Zugfahrzeugs 
ausgerichtet ist. In der Projektion der in Fig. 5 gezeigten 
Draufsicht, fallen x-Achse und Langsachse (9) zusammen. Die 
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Langsachse (9) des Zugfahrzeugs (7) und die Langsachse (8) 
der Deichsel (1) schneiden sich im Koordinatenursprung (0) , 
die Langsachse (10) des Anhangers (3) und die Langsachse (8) 
der Deichsel (1) schneiden sich im Schnittpunkt (Pi) und die 
beiden Langsachsen (9, 10) schneiden sich im Schnittpunkt 
(P 2 ) - Die Schnittpunkte (O, Pi, P 2 ) der drei Langsachsen (8, 
9, 10) bilden ein Dreieck mit den drei Winkeln (6 Af 6 B , 6 C ) , 
wobei der Deichselwinkel (0 A ) der Winkel zwischen der 
Langsachse (8) der Deichsel (1) und der Langsachse (9) des 
Zugfahrzeugs (7) ist; 

der Trailerwinkel (9 B ) der Winkel zwischen der Langsachse 
(10) des Anhangers (3) und der Langsachse (9) des 
Zugfahrzeugs (7); 

und der Anhangerlenkwinkel (0 C ) der Winkel zwischen der 
Langsachse (10) des Anhangers (3) und der Langsachse (8) der 
Deichsel (1) . 

Die Lange (D) der Deichsel (1) entspricht dem Abstand 
zwischen dem Koordinatenursprung (O) und dem Drehpunkt (Pi) 
der Deichsel (1) ; die Breite (W) des Anhangers (2) entspricht 
dem Abstand zwischen der linken und der rechten Ecke seiner 
dem Zugfahrzeug (7) zugewandten Vorderseite; und der Abstand 

(A) zwischen Zugfahrzeug (7) und Anhanger (2) entspricht dem 
Abstand zwischen der dem Anhanger (2) zugewandten Ruckseite 
des Zugfahrzeugs (7) und der dem Zugfahrzeug (7) zugewandten 
Vorderseite des Anhangers (2) bei Geradeausf ahrt , d.h. wenn 
die Langsachse (9) des Zugfahrzeugs (7) und die Langsachse 

(10) des Anhangers (2) parallel sind. 

Prinzipiell konnen die Breite (W) des Anhangers (2), die 
Deichsellange (D) und/oder der Abstand (A) zwischen 
Zugfahrzeug (7) und Anhanger (2) aus vorhergegangenen 
Messungen bekannt und abrufbar in einer 

Datenspeichereinrichtung hinterlegt sein. Im vorliegenden 
Beispiel werden jedoch Breite (W) , Deichsellange (D) und 
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Abstand (A) mit Hilfe des Laserscanners (11) bei 
Geradeausf ahrt regelmafiig vermessen und in einer 
Datenspeichereinrichtung hinterlegt, urn die Zuverlassigkeit 
dieser Daten zu verbessern. 

Die Deichsellange (D) kann beispielsweise wie folgt bestimmt 
werden: Bei einer Geradeausfahrt, steht das Zugfahrzeug (7) 
ausreichend genau in einer Linie mit dem Anhanger (2) und 
dessen Deichsel (1) (d.h. die Langsachsen (8, 9, 10) sind 
annahernd parallel ausgerichtet) . Mit Kenntnis der Breite (W) 
des Anhangers (2) und des Abstandes (d) des Drehpunkts (Pi) 
der Deichsel (1) von der Vorderseite des Anhangers (2) ist 
anhand der Gleichung 



die Deichsellange (D) bestimmbar. Die GrOJJen W, d und f sind 
beispielsweise einer Datenbank entnehmbar, manuell eingebbar 
Oder mit dem Laserscanner (11) ausmessbar. Dabei ist f die 
Brennweite des Laserscanners und L y und R y die im Bild unter 
Riickgriff auf die Breite (W) des Anhangers (2) bestimmbaren 
Abstande der linken und der rechten Ecke der Vorderseite des 
Anhangers (2) orthogonal zur x-Achse. Ist die Breite (W) des 
Anhangers (2) nicht bekannt, kann z.B. von einem Standardwert 
von 2,5 m ausgegangen. Marktubliche Anhanger (2) weichen von 
dieser Breite nur um etwa ± 0,1 m ab, woraus sich 
insbesondere bei der spateren Berechnung des Deichselwinkels 
(9 A ) und des Anhangerwinkels (6 B ) ein zu vernachlassigend 
geringer Fehler ergibt. 

Der Laserscanner (11) ist so an der Riickseite des 
Zugfahrzeugs (7) montiert, dass er in seiner Sichtebene den 
Anhanger (2) zumindest in seiner vollen Breite (W) vermessen 



D 



f-W 



+ d 
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kann. Dabei kann der Laserscanner (11) prinzipiell auch nicht 
in der horizontalen Mitte der Riickseite des Zugfahrzeugs (7) 
angeordnet sein. In diesem Fall ist jedoch die Verriickung des 
Laserscanners (11) aus der horizontalen Mitte in einfacher 
Weise f eststellbar, sodass der Ursprung des kartesischen 
Koordinatensystems beispielsweise durch eine einfache 
Transformation rechnerisch in die horizontale Mitte der 
Riickseite des Zugfahrzeugs (7) geriickt werden kann. 

Die Kupplung, uber die der Anhanger (2) iiber seine Deichsel 

(1) an das Zugfahrzeug (7) angekoppelt ist, ist ebenfalls in 
der horizontalen Mitte der Riickseite des Zugfahrzeugs (7) 
angeordnet und fallt in der Projektion der in der Fig. 
dargestellten Draufsicht mit dem Ursprung (0) des 
kartesischen Koordinatensystems zusammen. 

Beim Rangieren, insbesondere beim Riickwartsfahren, tastet der 
Laserscanner (11) das riickwartige Umfeld des Zugfahrzeugs (7) 
in einer Ebene ab. Dazu sendet er alle 0,25° einen 
Laserstrahl aus. Uber die Laufzeit des ref lektierten Lichts 
kann dann die Entfernung des ref lektierenden Messpunktes (mi) 
berechnet werden. 

Auf diese Art werden i Entfernungsmessdaten zu i Messpunkten 
(mi) gewonnen (i = natiirliche Zahl) , mit deren Hilfe sich die 
Vorderseite des Anhangers (2) erkennen lasst. Die Vorderseite 
befindet sich dort, wo die Entfernungsmessdaten abrupt 
kleiner werden, sich dann nur wenig andern (zu- oder 
abnehmen) und dann abrupt wieder grower werden. Die Ecken der 
Vorderseite des Anhangers (2) befinden sich dort, wo die 
abrupten Entf ernungsanderungen festgestellt werden. Mit Hilfe 
der zuvor bestimmten Breite (W) des Anhangers (2) lassen sich 
mit hoher Zuverlassigkeit alle zur Vorderseite des Anhangers 

(2) gehorigen Messpunkte (mi) bestimmen. 
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Durch die zur Vorderseite des Anhangers (2) gehorigen 
Messpunkte (mi) wird eine Ausgleichsgerade (G) gelegt, deren 
Lage im kartesischen Koordinatensystem somit bekannt ist. 
SchlieBen die Langsachsen (9, 10) von Zugfahrzeug (7) und 
Anhanger (2) einen Winkel 0 C * 180° ein, so liegt die 
Ausgleichsgerade (G) schrag in der Ebene hinter dem 
Laserscanner (11) . 

Mit der bekannten Breite (W) des Anhangers (2) kann nun eine 

Senkrechte (S) zur Ausgleichsgeraden (G) ermittelt werden, 
die durch die horizontale Mitte der Vorderseite des Anhangers 

(2) geht und die somit parallel zur Langsachse (10) des 
Anhangers (2) ausgerichtet ist. In der Projektion der 
Draufsicht von Fig. 5 fallen Langsachse (10) und Senkrechte 

(S) zusammen. Auf dieser Senkrechten (S) liegt der Drehpunkt 

(Pi) der Deichsel (1) des Anhangers (2) . 

Da die Deichsel (1) im Koordinatenursprung (0) beginnt und 
ihre Lange (D) bis zura Drehpunkt (P x ) bekannt ist und der 
Drehpunkt (Pi) ferner auf der Senkrechten (S) liegt, kann die 
Lage des Drehpunkts (P x ) im kartesischen Koordinatensystem 
bestimmt werden: Pi ist der Schnittpunkt eines Kreises mit 
dem Radius (D) urn den Ursprung (0) mit der Senkrechten (S) . 

Ferner ist die Lage der Senkrechten (S) bekannt, sodass deren 
Schnittpunkt (P 2 ) mit der x-Achse bestimmt werden kann. 

Die Punkte Ursprung (0) , Drehpunkt (Pi) und Schnittpunkt (P 2 ) 
bilden ein Dreieck, dessen drei Winkel (G A , 6 B , 0 C ) auf 
einfache Weise z.B. durch Ausmessen oder ein geeignetes 
Computerprogramm bestimmt werden konnen. Die Kenntnis von 
zumindest zwei dieser drei Winkel (9 fl , 0 B , 6 C ) liefert auf 
einfache Weise und mit hoher Zuverlassigkeit niitzliche 
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Lenkhinweise z.B. fur das Rangieren, insbesondere 
Rtickwartsfahren mit dem Gelenkzug (6) . 

Das Verfahren wird vorzugsweise nach einer Aktivierung 
vorzugsweise kontinuierlich durchgef tihrt . 

Gewerbliche Anwendbarkeit : 

Die Erfindung ist insbesondere im Bereich der Herstellung von 
Gelenkziigen sowie bei der Herstellung von 
Fahrassistenzvorrichtungen fur Gelenkzuge gewerblich 
anwendbar . 
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Bezugszeichenliste 

1 Deichsel 

2 Anhanger (Trailer) 

3 Reifen 

4 charakteristische Linie oder Kante der Deichsel 

5 charakteristische Linie oder Kante der Vorderseite 
des Anhangers 

6 Gelenkzug (Gliederzugzug) 

7 Zugfahrzeug 

8 Langsachse der Deichsel 

9 Langsachse des Zugfahrzeugs 

10 Langsachse des Anhangers 

11 Laserscanner 

A Abstand zwischen Zugfahrzeug und Anhanger 

D Lange der Deichsel 

G Ausgleichsgerade 

d Abstandes des Drehpunkts der Deichsel von der 
Vorderseite des Anhangers 

f Brennweite des bildgebenden Sensors (Laserscanner) 

L y , R y Abstande der linken und der rechten Ecke der 

Vorderseite des Anhangers orthogonal zur x-Achse 

mi Messpunkte 

0 Ursprung 

Pi Drehpunkt der Deichsel 

P2 Schnittpunkt 

S Senkrechte 

0 A Deichselwinkel 

9 B Trailerwinkel (Anhangerwinkel) 

0 C Anhangerlenkwinkel 
W Breite des Anhangers 
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Patentansprtiche 



1. Verfahren zur Bestimmung mindestens des Deichselwinkels 
(0 A ) und des Trailerwinkels (G B ) eines Anhangers (2) eines 
Gelenkzuges (6), wobei aus einem Videostrom eines 
bildgebenden Sensors (11) charakteristische Kanten und 
Linien (4, 5) mindestens der Deichsel (1) und der 
Vorderseite des Anhangers (2) ermittelt werden, aus deren 
geometrischen Verhaltnissen und/oder relativer Lage 

zueinander mindestens der Deichselwinkel (0 A ) und der 
Trailerwinkel (G B ) des Anhangers (2) bestimmt werden. 

2. Verfahren nach Anspruch 1, 
dadurch gekennzeichnet , 

dass zunachst anhand der relativen Lage und/oder der 
geometrischen Verhaltnisse der charakteristischen Linien 
und Kanten (4) der Deichsel (1) der Deichselwinkel (G A ) 
zwischen Zugfahrzeug (7) und Deichsel (1) bestimmt wird 
und anschlieflend anhand der relativen Lage und/oder der 
geometrischer Verhaltnisse der charakteristischen Linien 
und Kanten (5) mindestens der Vorderseite des Anhangers 
(2) der Trailerwinkel (9 B ) zwischen Zugfahrzeug (7) und 
Anhanger (2) bestimmt wird. 
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3. Verfahren nach Anspruch 1 oder 2, 
dadurch gekennzeichnet, 

dass zur Bestimmung der geometrischen Verhaltnisse und 
der relativen Lage der charakteristischen Kanten und 
Linien (4, 5) der Deichsel (1) und mindestens der 
Vorderseite des Anhangers (2) ein Koordinatensystem, 
dessen Ursprung (O) vorzugsweise im Brennpunkt (f) des 
bildgebenden Sensors (11) liegt, verwendet wird. 

4. Verfahren nach Anspruch 1, 2 oder 3, 
dadurch gekennzeichnet, 

dass zur genauen Bestimmung mindestens des 
Deichselwinkels (9 A ) und/oder des Trailerwinkels (9 B ) 
neben den geometrischen Verhaltnissen und/oder der 
relativen Lage der charakteristischen Kanten und Linien 
(4, 5) jeweils der Deichsel (1) und der Vorderseite des 
Anhangers (2) zueinander, zusatzliche, 

anhangerspezif ische Daten, insbesondere der Abstand (d) 
des Drehpunktes der Deichsel (1) von der Vorderseite des 
Anhangers (2), die Lange (D) der Deichsel (1), sowie die 
Breite (W) des Anhangers (2) , beriicksichtigt werden, 
welche entweder manuell eingegeben, einer Datenbank 
entnommen, oder wahrend des Ankuppelns automatisch 
bestimmt werden. 

5. Verfahren nach einem der Anspriiche 1 bis 4, 
dadurch gekennzeichnet, 

dass zur Bestimmung des Deichselwinkels (G A ) zunachst 
eine 2D-Ableitung des Videostromes des bildgebenden 
Sensors (11) und anschlieftend eine Binarisierung mit 
einem Schwellenwert durchgefiihrt wird, so dass die 
charakteristischen Kanten und Linien (4) der Deichsel (1) 
eindeutig hervortreten, wonach aus dem binarisierten 
Videostrom anschlieBend die charakteristischen Kanten und 
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Linien (4) mittels einer Hugh-Transformation gefiltert 
werden und ein Modell der Deichsel (1) auf die 
gefilterten Kanten und Linien platziert wird, urn 
anschliefiend mit einem Iterations-Algorithmus die Lage 
des Modells auf den gefilterten Kanten und Linien so weit 
zu optimieren, bis der tatsachliche Deichselwinkel (0 A ) 
gefunden ist. 

6. Verfahren nach Anspruch 5, 
dadurch gekennzeichnet, 

dass zur Bestimmung des Trailerwinkels (0 B ) zusatzlich 
ein Modell der Vorderseite des Anhangers (2) auf die nach 
der Hugh-Transformation gefilterten Kanten und Linien 
gelegt wird, welches ebenfalls durch einen Iterations- 
Algorithmus in seiner Lage auf den gefilterten Kanten und 
Linien so weit optimiert wird, bis die Lage des Modells 
mit der Lage der charakteristischen Kanten und Linien der 
Vorderseite des Anhangers (2) im Videos trom 
ubereinstimmen, wobei anschlieBend anhand des 
Deichselwinkels (0 R ) und der Lage der charakteristischen 
Kanten und Linien der Vorderseite des Anhangers (2) eine 
geometrische Berechnung des Trailerwinkels (G B ) erfolgt. 

7. Verfahren nach Anspruch 6, 
dadurch gekennzeichnet, 

dass zur Bestimmung des Trailerwinkels (G B ) zwei vom 
Brennpunkt (f) des bildgebenden Sensors (11) ausgehende 
und an der linken und rechten Kante der Vorderseite des 
Anhangers (2) jeweils unter einem Streifwinkel 
vorbeistreif enden Streiflinien verwendet werden, welche 
in ihre Komponenten in einem Koordinatensystem, dessen 
Ursprung (0) vorzugsweise im Brennpunkt (f) des 
bildgebenden Sensors (11) liegt, zerlegt werden, so dass 
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eine Bestimmung des Trailerwinkels (0 B ) durch Losung der 



Gleichungen 



w . 



und 



D • cos0 A +—-sia0 B -d- cos 9 B 
W 

D-smd A + — cos^g + d-smO B 

w 

D-cos9 A — ^--sin^j-rf-cos^ 



D-sm0 



W 

— -cos0 B + d-sin9 B 



0, = arctan^- 
h 

0 R = arctan— 
erf olgt . 



Verfahren nach Anspruch 6 Oder 7, 
dadurch gekennzeichnet, 

dass zur Verbesserung der Genauigkeit zusatzlich ein 
Modell der Ladeflache auf im binarisierten Videostrom 
erkennbare charakteristische Kanten und Linien der 
Ladeflache gelegt wird. 

Verfahren nach einem der Anspriiche 1 bis 8, 
dadurch gekennzeichnet, 

dass zusatzlich ein Kallmanns-Filter verwendet wird. 



10. Verfahren zur Bestimmung mindestens des Deichselwinkels 
(G A ) und des Anhangerwinkels (0 B ) eines Anhangers (2) 
eines Gliederzugs (6), wobei aus einem Videostrom eines 
Laserscanners (11) charakteristische Kanten und Linien 
mindestens der Deichsel (1) und der Vorderseite des 
Anhangers (2) ermittelt werden, aus deren geometrischen 
Verhaltnissen und/oder relativer Lage zueinander 
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mindestens der Deichselwinkel (9 ft ) und der Trailerwinkel 
(6 B ) des Anhangers (2) bestimmt werden, 
dadurch gekennzeichnet, 
dass man 

a) mit Hilfe des Laserscanners (11) die Entfernungen zu 
Messpunkten (mi) an der Vorderseite des Anhangers (2) 
ermittelt, wobei die Messpunkte (m ± ) in der Ebene eines 
zweidimensionalen kartesischen Koordinatensystems liegen, 
dessen Ursprung (O) der Laserscanner (11) ist und dessen 
x-Achse parallel zur Langsachse (9) des Zugfahrzeugs (7) 
verlauf t; 

b) eine Ausgleichsgerade (G) durch alle Messpunkte (mi) 
bestimmt; 

c) eine die Mitte der Ausgleichgeraden (G) schneidende 
Senkrechte (S) bestimmt, wobei die Senkrechte (S) 
parallel zur Langsachse (10) des Anhangers (2) verlauf t; 

d) mit Hilfe der Lange der Deichsel (D) und der Lage der 
Senkrechten (S) den Drehpunkt (Pi) der Deichsel (1) 
bestimmt; 

e) den Schnittpunkt (P2) der Senkrechten (S) mit der x- 
Achse bestimmt; 

f ) die Winkel (9 A , 9 B , 9 C ) in dem aus Ursprung (0) , 
Drehpunkt (Pi) und Schnittpunkt (P 2 ) gebildeten Dreieck 
bestimmt, wobei es sich 

bei dem Winkel zwischen der Langsachse (8) der Deichsel 
(1) und der Langsachse (9) des Zugfahrzeugs (7) urn den 
Deichselwinkel (9 fl ) handelt; 

bei dem Winkel zwischen den Langsachsen (10, 9) von 
Anhanger (2) und Zugfahrzeug (7) um den Trailerwinkel 
(9 B ) handelt; 

und bei dem Winkel zwischen der Langsachse (10) des 
Anhangers (2) und der Langsachse (8) der Deichsel (1) um 

den Anhangerlenkwinkel (9 C ) handelt. 
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11. Verfahren nach Anspruch 10, 
dadurch gekennzeichnet, 

dass man anhand der mit Hilfe des Laserscanners (11) bei 
einer Geradeausf ahrt ermittelten charakteristischen 
Kanten und Linien des Anhangers (2) und bei einer 
Geradeausf ahrt gemessenen Entfernungen zu den Messpunkten 
(mi) an der Vorderseite des Anhangers (2) die Breite (W) 
des Anhangers (2) bestimmt. 

12. Verfahren nach Anspruch 10 Oder 11, 
dadurch gekennzeichnet, 

dass man anhand der mit Hilfe des Laserscanners (11) bei 
einer Geradeausf ahrt ermittelten charakteristischen 
Kanten und Linien des Anhangers (2) und bei einer 
Geradeausf ahrt gemessenen Entfernungen zu den Messpunkten 
(mi) an der Vorderseite des Anhangers (2) den Abstand (A) 
zwischen Zugfahrzeug (7) und Anhanger (2) bestimmt. 

13. Verfahren nach einem der Anspruche 10 bis 12, 
dadurch gekennzeichnet, 

dass man anhand der mit Hilfe des Laserscanners (11) bei 
einer Geradeausf ahrt ermittelten charakteristischen 
Kanten und Linien der Deichsel (1) und bei einer 
Geradeausf ahrt gemessenen Entfernungen zu den Messpunkten 
(mi) an der Vorderseite des Anhangers (2) die 
Deichsellange (D) bestimmt. 
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